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A, ..INVERTED PENDULUM HORIZONTAL POSITION Xb 

B, ..UPPER BODY MASS POINT OFFSET 

C, UPPER BODY TYPICAL POINT 
□...UPPER BODY COORDIHATE SYSTEM 

E. .. SWING LEG FLAT MASS POINT OFFSET 

F. ..SWING LEG FLAT 

G. .. INVERTED PEHDULUH HEIGHT h 

H. .. ABSOLUTE COORDIHATE SYSTEM <GLOaaL COORDINATE SYSTEM} 

I . . . ROBOT ZMP 

J... INVERTED PENDULUM ZMP (= 2MPp«nd> 
K. ..LOCAL COORDINATE SYSTEM 



(57) Abstract: A legged mobile robot, 
particularly, a biped robot, wherein a dynamic 
model showing the relation between the motion 
of an upper body and a leg part and a floor 
reaction is provided, the parameters of gait 
patterns including the parameters determining 
the routes of the leg part are determined 
temporarily, the parameters of cyclic gait patterns 
followed by the gait patterns are estimated, the 
parameters of the gait patterns are corrected 
so that the routes of the upper body determined 
based on the dynamic model and ttiQ parameters 
of the gait patterns are converged to the routes 
of the upper body determined by the parameters 
of the cyclic gait patterns, and Ihe instantaneous 
values of the gait parameters are determined 
based on the corrected parameters, whereby 
the gait patterns such as any step, turning angle, 
and walking frequency can be generated by 
generating freely and in real time the gait patterns 
including the floor reaction while meeting the 
requirements for dynamic equilibrium, the gait 
patterns allowing the continuous displacement 
and speed of each portion of the robot and a 
high allowance of stability can be generated 
in the boundaries between the generated gait 
patterns, and the gait patterns can be generated 
by predicting the future behavior of the robot so 
that an inconvenience such as an uncontrollable 
attitude is not produced. 
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1) im.^^'rJl 

imM'^fJUt^ m(i#4:^3p4_ 1 5 0 6 8 ^^^Tm^$nT*J«?. ^(D 

zomMwm^'m?>o^^y humtmitxm^^^cf^'c. mK:b^imi^tczi:(D 

fc-fH^cD^-B^^iKtCifc-tj-^S 2^i#fir»J (a:$:a4^^y b^^fg (JRS J) , 
Vol. 13, No. 7, Oct., 1995) ^^if ^ C tf^^X^ 

mx'&^bfz um^^^mi^^x^n^^^ c tf)^x^ 
^s^^T^^utcafeoTt,. f^mmni}^ikmmi^<z>x\ mm^\z:nmmwi^=f'mb 

Ltztf<-^x^ co^HjcD^ 1 cDafl*j(is ^mmA*<5fe{c#r?a^ 1 o - a e o a 
1 ^iz:^^^xmMhtc^m^m^(D^7'ji^n<tt$im(D±mviz:f^^^^=^mm u 
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^^m^^u A-m^^i^m< mm^-m^o^<y ^ - ^ ^mMh. mti^^^^^i' 

sane H CD^^<&^^T^ J; ^ L/ilHls^^i& a jj? h ©^^^Jj^^g^m^-r 

ClirT^^-e^So i^. a^^^T^^L-f*. 'B»J^«'^T4 - 1 5 0 6 8 -^iattglTSI^ 
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mMPpend ^mi^-t6<D{zm^^^-, mmow^c[>mB:htm:ti(D^:fj<Dr?m^p 
(omm^^-r ^ • h-e^So 

MZMPpend ^mmmmhi^xw-ir ^ • f-i-- h-c-fe^o 

m OSI{i. TO{w^4 0(r^t-i&:f3^^f';l/®®5:|g^=^©3£,^^iS^^t-Z 

HI 4IEI{*. Il«ltc, HI 2EI:7a- • + - h-e^Mt-'5^ltfig|fi[^^OJi 
HI SIMfi. HI 2liIyo- ■ f-i-- h©^^i6^ini^^:^(Z)%riKaigtfc^^®#ai 
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JEISB) ©IffllgBUSi ClSifg) fflcDMfiiil OR, 1 OL C^&M^&R. £M^L fc-T-S 
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Nlltf 1 8 R (L) , 2 0 R (L) ©TSBJCrtS^F (S^U) 2 2 R, 2 2 L A^flX 

asMiif (ih^\^H±mum \mm \ or (d , i 2r (d , i 4r (l 

) MTO (J£-g-MfEi5) {d:Mti! 1 8 R (L) . 2 0 R (L) ^^^^ttfi^^n-S 

a Sf^flSMfdSt^Mlfi^rU::^]^'; 2 8 R, 2 8 L> I^MJ®i:J£MtEii:{iT!gS 



mn^\::^ti^<QQ* 2=1 2^cDMgi5^M^i:^JS-eiE16-r'Sci:-C\ s 



©3:^[Sl^^Fx, Fy, F 2 t^-^ > b0 3:^[Sl^43'Mx, My, Mz 
Il2ll{::^-rj;'5«::. S¥2 2R (L) OJi^fJCJi, li*aM«l3 8 Ti^^-fif^ti 
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0 5 5 8 4■^(CK®^tl•CV^;5®T^ i^aB>SiJSPJIi#H§-r<5o 
^<0^:}2\t-fl^y^ ^ 6*^bTRAM5 ^mzXti^tl^o 

-rstfttr, ^^ja^cosp < mfflfftigtefi^^^aj u" rams 4{r^ai^-So 

^2©^S:^S6 2liRAM 5 4 7Ji>^'ecDm^t^£li^*lfc|IS(HiSt^^<5-ai b 
. #BlgiSC!>ISia{CjfiJ^/j:ISIfFg^3^KbrD/'A^|g||| CHIfc td/Aj b^t 

) 6 6 t-y— !j5T>:?*^:frbTi&Kfa5*ffi»-rssi»^-:s?{rm:ti-r-eo 
aio$n< i^^^^S^E:*>oUT;u;j'^A{::^j5Rb-rai:^j-rSo BM^^^ti. i 
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mzuF) emit) ^xv^um±m^i: (mM$>^^^it^^:^-» i)^>>fs.^o 

Kit:^B!,mA^mzmm^ 10-277969 ^^miz^'i^xmmi^i^u^-=^ > 

^(D^izumLfzmm^^itpum^h ^xit. m^ti^>ij^^ (zmp) cd@^ 

et. u^m^ti=^i^Mti^iz-r<h-t^tiz^'^xmms.:f]^irihu m$^m7t:fi 

i}^f}s^m<. m^^m^my viz^i^^xii^ ^mmmmmtEmmK-^^^^- 
y(Dmm:bmti^m^m^^^m^Lxiyfs:ifti\t^ ^^Ltz^mmmx^t^ 
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r^^Pj tnf ^^CDpMli, 5fc{Cf|^b!^#W¥ 1 0 - 8 6 0 8 1 -^^Zjlgtc 

h I'^mmnmi^j^'ox^t^u-^-^m^^^izm^^tii^x^. ttc, @a 
cd-e, ^mm^tLxom^^mm-r^^ 
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^m&^i^'imMnT^-y'ji'^M^izm^i-^ztizm^iibtsii.^) c 
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aft 1 ) Jl(*«. -0.. zMP:^>^^>^< (r]iin§ ts $ ^{cit< fci^ni:^ t 

2) jtW^^ffi(c:fev>TZM?75-«3^^)lM¥1lliifeffi[^(;:^j:{tn{i^d:'=>^^ 

it. ^{zmm.vfci$.mh^ibxm^xit:^'^mx'^-ofca 
K-ti^<^/-i^) ij^ibmm^ti^o t^. c<Dmmmx 
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^Kl/-?^;^-^'^^ emit) /-^^^-jJ'^Jii*: CW.it) ^ -iS^ fc*^C. 
$fe(w:$:aillAd-<#M¥5 - 3 1 8 S 3 9^*Ji:d«#W^ 5 - 3 2 4 1 1 5 

- 3 2 4 1 1 5'^^m-c:^fiimAi!}mmLfcnm^^i&-r^^m^^±t^ 

©TK^iag (xb , yb ) 43j;CJf^f§' (0xb. 0yb, 0zb) om^^Wi}^^ 
Hb^tl^o -b#:]ft$ zb ltM:^fl^m. m^ii^^^l^MAt^^m^ I 0 - 8 6 0 8 
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:(^^©#lb^^fflllb> ifCaX'^iZ^^^i^ /-^ris^^^'^-rmt. a5i?vh©# 

ft 6 0) omti-cimm-c^^o 

mti^-h^n:s.\zfp.=^mzmm^mhmz. a^.^j v±wom:fimt. ^n?.© 

n CCD^T^^Ki, ^Jta^. »S¥M,^0 3|r^7&^^>«i34 

2) %mm&^n^\t. %nmM.w\za-ti;]^\,zm^^fifz.mmjh 
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l^;i>^^'trfe^o 'PJSllS^^.fefeg^^Jililg^e^OZMPfe® (ZMP 

msup i^^MW.^MS. 

mswg 

ratotai id'i^-v ^WM (= mb + msup + mswg) 
mfeet : WMMM. (= msup + mswg) 
xsup z^nmmAitMi 
xswg •.MMMM.^W. 

•r§^~^:/^^^ *.P**3t?cDlHim®i*:^jt-^>hi:^^-r^ (lSE;titfi 

o 
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=msup(xsup-xp) *G-msup(xsup-xp) *d2(xsup)/dt2 
+mswg(xswg-xp) * G~inswg(xswg-xp) * d2(xswg)/dt2 

■ • -^1 

)J^ZMP^Zlff>feet^ia«!iU fli Z M P 2 -C^^f ^ a tcfcL^ mZM 
PCDI^^ (ZMPfeet cDZg^^) {t^ ^^P^Itco^lS^ irl^-ir-T-So c <Z> <}; -5 

^.P ^fc ?) > h=irifeet* (ZMPfeet-xp) * G 

' ' - mz 

p. PZMPCZMPfeet)'. *> J: WJScli^ Z M P (ZMPpend) ©r^twIiiScS; 3 

ZMPpeiid=mtotal /mb * e^ZMP-urfeet/ mb *ZMPfeet 

• • • ^3 

d2(3d>) / dt2 ®7k¥f5c5> = g/h * (xb <D7i^^m^ ZMPpend ©tK^SS^^) 

• • • tfc 4 
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m.^-ir:^b. iti:^j^^^S|il±lfflIZMP#ffill 2 0 0 ^^i;t. )WIZMP^aill2 0 

P (ZMPfeet ) ^»mi-^o 
m^-ri, _biB^mbfcZMPfeet ^mfeet/mtotaHgb/ct)CD^> i^ZMP7!>N<5, 
^e>{C@-:>TII'fc||^mtotal/mb ^"T S C t {I J: oTs -^:&I6^ZMP(Z 
MPpend) ^nUi-r^^ B[It>. -aSim^^ZMP CZMPpend) tfj^a^y 
mtotaltmE±f4:©^j^©5Cfimb©ifc{CH«iBgl!IZMP*^U;T#fclt;5^e>. fr 
i2IWIgpcD^:Miiifeet tffiB-Lf*CD®,^cDMnibOtfc(rffllg|5cDZMPffl^1itZMPfee 

WSEJi-T-O^Sf^s mxJ:4-T:-aa^n. «lg^ZMP(ZMPpend) 7:?^^.{SlJim 

ft 6 Eli:: ^-r fin < > mi]^^»Mit±.i^^m^^^2 0 2 «-«i;^, ± 
i*:'tS:a^^^2 0 2 Id:. #iS^^^K^7KTOg;^r< ^-bf4:®7K¥^ffxb^;^^-r ^ 
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m = sqrt(g/h) (/ifc'b. sqrtW:^m^^t>t- o ) 
At : M^^I^M 

ZKlPpend[k] : k:^y'yyE cDMjE^-T-Z M P b < B#Mk A 1 «»^^ 
(k+1) A t ^-e. ■A:f]ZMPpeQd[k]CDO|5^jJ;-;l.Kbfc'ft-^7b-?A:^)-, Hp-fe. ^Ol^ 

^^{c. q ck] i:p [k] ^m^B-v^mt^c 

qPc]=x[k]+v[k]/a)0 
p[k]=x[k]-v[k]/a;0 

• • • ^ 5 

m 

k-l 

=e35p(-coOkAt)*(prO]+(exp(a)OAt)-l) £ (exp(ia)0 At)*ZMPpend[i])) 

i=0 

• • • ®[ 6 

=exp(<wOkAt)*(q[0]+(e3cp(-Ci>0At)-l) £ (exp(-i(iJ 0 At)*ZMPpend[i])) 

i=o 

... ^7 

ZMPmm^ZMPpead[i]^ZMPmax 

m 1^ mum 
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k-1 

p[k]^exp(-a)OkAt)*(p[0]+(exp(a)OAt)-l) (exp(iwOAt)*ZMPmax)) 

i=0 

... ^9 

fc-i 

£ exp(iCD0At)=(l-exp(ka3 0 At)) / (l-expCcoO At)) 
i=0 

••■^10 

p[k]^exp(- CO Ok A t)*p[0]+(l-exp(- CO Ok A t))*ZMPmax 

• • -^11 

pPk] ^exp(- 0) Ok A t)*p[0]+(l -ea£p(- O) Ok A t))*ZIV(Piniii 

■ ■ • 1 2 

. 1 2li. ZMPpend UT*)p[k] {4lgt§[-&-r> V^-rnt*ZMPIIlaxtZMPmm© 

p[k]=exp(- CO Ok A t)*(p[03 — ZMPO>fZMPO 

•••^13 
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mii^mtl^X^ ZMPpend t}<3b^9^^&i^. — ^iiSZMPOH:^j:§^^^#x.^o d 
ctil*. q[0] - ZMPO X'ltm-m.^> q [k] 75^ ZMPO*^ 

q|]c]^exp(coOkAt) * (q[0]-ZMPO) +ZMPO 

• • • IBC 1 4 

^C-e. iS[^5 d^oT^il^n^P Ck] ^tR^^^a-x q Ck] ^ r 

eig 1 : 

amfiS^p Ck] t^^^^q Ck] ^^366sSi<OSV^(*s p Ck] irq Ck 
2 : 

AtiZWvQUintl^X. ZMPpend[0]= UO ZMPpendCi] = 0 (i = 1.2....) 
'Z?^t>$n5^^VU>^^#;^.§ -ecDi^CDq Ck] t*. 7 (CC ©ZMPpend [ 
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q[k]=e3cp(Q) Ok At)(q[0]+(exp(- CD 0 At)- 1)U0) 

• ' • 1 5 

:A)-rsctt±. uo * (expC- 6)0 At) - 1) fi^mmmki^^iT ^ir z. h tm 
h^m^^^^o fiP-Bs ^m^^JV:^its (expC-<wOAt) - 1) ^gl-'Sc: t(rJ:o 

k-1 

U0= £ (exp(-toQiAt)*ZMPpend[i]) 

i=0 • . . • m 1 6 

■BP-^'. A:^ZMPpencl[i]Ci-0.1.2./..k-l) It. m^l BK^^X. OT^^VI.:^ 

^/c. 0 9l§lJ-^-rj;-5(C. ZMPpeDdCilTb^^^-sei^fCO-^fe^^ ZMPpend' [i] 
tfiMWiKO^^mnAttmrnih^tiMmtCi- nAt)-C?*.5tU A:^l3^tfZMPpeh 
d[i]^OT^^VVXfC^mO/i:4)®^U0. A:S^JZMPpend' [il ^&?!Jffl^^VI/X(;:^m 

Uff =U0 *exp( - nco 0 A t) 

' ••■^17 
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o 

{::B|■r§!^#{=oV^T(4^ ^iBf ^I^lwji, ^jlli-^ZMPli. 

7d^P^ (7K™±) ^^mt-^i^^ JB(T®illiSfT(±> ai^cD^^C^^s 

#m^^cDZ]V[P (ZMPpend ) fSJ^tbr^l 0 Ef'^-T ^ ^^Sftr^^i®^ 

T/At-1 

H(f(t),T)== E ■ (kAt)exp(-cokAt) 

. . -1^1 8 

H(1,T)K1 - exp(~ ^ t)) / (1 - expC- o) A t)) 

• ■ • ifcl 9 



# ^ M IS CMIfi26) 
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H(t,T)/r=(At/T*e3cp(- O) A.t)H(l,T)-exp(- cot)) / (1 -exp(- co At)) 

• ■ • iS[2 0 

CDV. y^JVxm^mtm^ 2 1 (C:^-f J: O iCfSi^o 

• mf[i]=Hj(l, period[i])*ZMP[i]+H(t, peiiod[i]) / period[i]*(ZMP[i+l] -ZMP[i]) 

• • -^2 1 

rn^-V. KHperiodLi] 0=0.1,.,, in)oMAz:Sg^ZMP ©^if^. WMOiz 

i-1 

inf '[i] = mf[i]*exp(~ coOC£ period[k])) 

• • • 15:2 2 

mi 01lJr^-r#jA£m^-ZMPffif$:^M®^#}i> #E:Fa1cDTO!g-?-ZMP 



M # ;l M M (MM026) 
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W=Imf'[i] 

. ■ - IS[2 3 

( 

W*(«xp(-coOAt)-l) 

■ • • iS[ 2 4 

m 

W*(exp(-a>0At)-l)*exp(6D0( period[i])) 

1=0 

■ • • M. 2 5 
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0 Kmt^o 

S 1 8{Cjitft^lil^StJt*0{::^S^I^fcU ?J;<.^-CS2 2izm^. ^m^^% 

a 
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. ^nizm^s-cmm^^m-t^iz^^m^mmm-r^o 
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1^ 1 mm^m^mmm&^^m^mit. ■^m^mmmMm^w-i^m:mm<z>^m 

i!r^'oMm£m<t'^l^^£\'^2:'5iz^^-r^<, 
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m!^3 i:mS;7^f>. 2^CD^S;2 6 35^#^,n^o g^^ZMP^ZMPtotal t 
q[k] =exp( Ok A t)*Q[0] 

fc-1 

- +exp(a)OkAt)*(-exp(a>OAt)'-l) exp(-a)0 At)*MtotaI/mb*2aV[Ptotal[i]) 

i=0 
k-1 

-exp(6t>OkAt)*(-e3cp(caOAt)-l) I exi>(-i6)0 At)*mfeet/mb*ZMPfeet[i]) 

i=0 

• - •iS[2 6 

P^. r|5?.:^^mj25c^j tifiO ^^2e>5C fc^#;tSo Wo^s ^^Mms^^ 

M # X. ffi iis (mm) 
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^*^66S^ iS[^l 9, 20. 21, 22, 23, 2 5 iC^f T;l/:d'>J XA^Srm 
0^-Cl?IJr6*J{r«a6So cn^Wzmptotalt-T-So (.XY:^\^A<^^(Q'C. Wzmpt 

ift^fe^U, $ ^{::ZMPfeet[i3Ci=0. l.-.k) 1 , 2^^^ib^ Zti^ 

±iB©$0< LT5Ri6?>nfc1S*Wfeett-rSo (XY:^ffii7!)^*>^cDT% Wfeet 
{*2 2fe7n^^ WKr^cSo ) 
JeiJnJ:?). MWi^Z 7^#^o 

q|k]=exp(Ci>0l5At) * q[03+Wzmptotal+ Wfeet 

• • -^2 7 

qIP3=q'|ic] 

• • • t5:2 8 
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qllcl^Mq'IXl+B 

•••^29 

qjk3=.MqIP}+B 

• • -ms 0 

MqfO]+B=exp(a)OkAt) * q[0]+WzmptotaH- Wfeet 

• ■ ■ las 1 

^ h 0 >y ^XAcD5|[fT^«l^inv(A) tiaj^-T^^, 1 A^ <5> ISCS?; 3 2 ^# 

q£03= iiiv(M- exp(<oOkAt)I)(Wzmptotal+ Wfeet- B) 

• • • iSc3 2 

^i^x\ s 1 0 Bi::m^. M'^mmwm^^wc^^ q. co] ^4^ii^^©5:#ffli 
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